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ABSTRACT 


This  paper  addresses  passive  contact  tracking 
using  measurements  from  a  perturbed  multiple 
element  linear  array.  Time  delay  measurements  of 
ray  path  range  differences  between  array  sensors 
are  considered  where  sensor  positions  are 
perturbed  off  the  mean  array  axis.  Estimator 
performance  is  analyzed  and  it  is  shown  that 
under  large  range-to-baseline  conditions, 
uncertain  array  position  can  yield  unacceptable 
solutions.  Specifically,  velocity  estimates  are 
shown  to  be  particularly  sensitive  to  the  rate  of 
change  in  array  shape.  A  method  utilizing  a 
speed  constraint  is  proposed  for  compensation  or 
reduction  of  estimation  bias.  To  achieve  this, 
general  inequality  constraints  are  incorporated 
into  an  iterative  least  squares  estimator,  and 
performance  is  demonstrated. 


I.  INTRODUCTION  j 

Tracking  using  measurements  from  a  linear 
array  represents  a  nonlinear  state  estimation 
problem  that  utilizes  both  array  and  processing 
gains  to  obtain  contact  state  estimates.  Typ¬ 
ically,  this  problem  involves  the  determination 
of  position  and  motion  of  an  acoustic  contact 
from  noise  corrupted  time-delay  measurements 
derived  from  spatially  distributed  sensors.  Time- 
delay  measurements  are  generated  by  cross- 
correlating  signals  received  at  each  of  the 
subarrays  as  shown  in  figure  1  for  a  three 
element  array.  The  array  of  sensors  can  be 
stationary  or  attached  to  a  mobile  observer.  In 
either  case,  large  separations  between  sensors 
provide  the  baseline  necessary  for  good  tracking 
performance.  However,  the  problem  is  complicated 
when  the  precise  location  of  each  sensor  is 
uncertain.1  When  the  array  is  being  trailed 
behind  a  mobile  observer,  lateral  array  motion 
can  result  from  perturbations  in  observer  velocity 
as  well  as  from  environmentally  induced  excita¬ 
tions  distributed  alorg  the  array.  Hence, 
inaccurate  array  shape  assumptions  can  induce 
modelling  errors  into  the  estimation  process. 

The  contact  state  estimation  problem  addressed 
here  is  not  amenable  to  simple  solution  since 
intrinsic  system  nonlinearities  preclude  the 
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application  of  conventional  linear  estimation 
techniques.  Estimation  algorithms  based  on  a 
first  order  linearization  approximation  that 
employ  an  anomaly-free  array  model  have  been 


developed. 


In  the  presence  of  array  motion 


misraodelling,  imprecise  array  shape  parameteriza¬ 
tion  can  induce  significant  errors  in  contact 
state  estimates.  Under  these  conditions,  estima¬ 
tion  accuracy  can  be  improved  via  utilization  of 
any  a  priori  information  about  the  contact's 
state.  For  example,  previous  studies  have  shown 
that  for  the  bearings-only  tracking  problem, 
significant  performance  gains  can  be  realized  by 
constraining  the  contact  state  in  the  estimation 
process.4 ' * 

This  paper  extends  previous  investigations  on 
constrained  passive  localization  and  motion 
analysis  to  include  measurements  derived  from  a 
linear  array  in  the  presence  of  array  motion 
mismodelling.  For  this  application,  contact- 
observer  dynamics  are  modelled  in  a  cartesian 
coordinate  system.  As  in  (2)  and  (31,  contact 
position  and  velocity  estimates  are  generated  by 
an  iterative  least  squares  estimator  that  utilizes 
a  Householder  transformation  to  solve  the  Gauss- 
Newton  equation.  The  algorithm  can  accommodate 
either  the  collinear  array  assumption  or  some 
other  presumed  array  shape,  and  is  augmented  to 
comply  with  general  inequality  constraints.  Array 
deformation  is  characterized  by  a  lateral  dis¬ 
placement  from  a  collinear  array  at  each  sensor 
location  as  shown  in  figure  2.  Displacements  are 
mapped  into  parameters  defining  array  shape,  and 
estimator  performance  is  characterized  as  a 
function  of  these  parameters.  For  purposes  of 
analysis,  a  sinusoidal  array  perturbation  model 
is  used  to  denote  the  difference  between  true 
and  an  assumed  collinear  array  shape.  A  speed 
constraint  is  then  imposed  and  the  concomitant 
performance  gains  are  illustrated  through 
simulation  experiments. 


II. 


CONTACT/OBSERVER  DYNAMICS  AND 
MEASUREMENT  MODEL 


An  absolute  coordinate  system  is  utilized  for 
the  target-observer  geometry  described  in  figure 
3  where  the  origin  is  defined  as  the  observer 
position  at  the  time  when  the  first  measurement 
becomes  available.  The  contact  is  assumed  to  be 
traveling  with  constant  velocity.  In  many 
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tracking  applications,  observer  maneuvers  are 
either  necessary  or  highly  desirable  to  enhance 
system  observability.*  However,  with  time- 
delay  measurements  generated  from  a  linear  array, 
no  observer  maneuver  is  required  for  two-dimen¬ 
sional  contact  position  and  velocity  estimation. 
To  clarify  the  tracking  aspects  presented  in  this 
paper,  no  observer  maneuver  is  utilized,  and  an 
infinite  homogeneous  underwater  environment  is 
assumed. 


where  the  rotation  angle  0(k)  denotes  angular 
deviation  of  the  array  from  the  mean  array  axis 
while  the  distortion  d(k)  describes  bending  of 
the  array.  With  array  shape  defined  by  array 
distortion  and  rotation,  displacement  of  sensor 
yi(k)  merely  denotes  a  translational  displace¬ 
ment  of  the  array  from  the  mean  array  axis.  Note 
that  given  array  shape  and  displacement  y i ( k ) , 
lateral  displacement  of  sensors  2  and  3  is  given 
by 


Acoustic  hydrophones  are  presumed  to  be  evenly 
spaced  along  the  trailing  linear  array  with  fixed 
sensor  separation  L,  as  shown  in  figure  3.  The 
Ii(k)  vectors  define  relative  position  of  the 
three  hydrophone  acoustic  centers  at  time  k  with 
respect  to  the  initial  observer  position.  The 
r,(k)  vectors  denote  the  special  separation 
between  the  contact  and  each  sensor  and  are  given 
by 

r'<k)  =  T(k)  “  *i(k)  =[lj(k)]-[l|J(k)]  (2.D 

with  r«(k)  and  ry(k)  denoting  contact  posi¬ 
tion  in  the  absolute  coordinate  system.  Time - 
delay  measurements  reflect  the  differences  in 
travel  time  of  sound  propagation  from  the  contact 
to  each  acoustic  sensor.  These  are  generated  by 
cross-correlating  the  signals  received  at  each 
sensor,  and  are  modelled  by 

ri(k)  =  (R2(k)  -  R,(k)  )/c  +  9,(k)  (2.2) 


-2<k)  =  (R3(k)  -  R2(k)  )/c  *  n2w  (2.3) 

where  R,(k)  -  1 1 r,(k)  n  denotes  the  ray  path  range 
from  contact  to  the  i'th  sensor,  c  is  the  speed 
of  sound,  and  n,(k)  and  denote  uncorrelated 

zero  mean  additive  noise  components  with  common 
variance  a*.  A  measurement  of  the  ray  path  range 
difference  for  sensors  l  and  3  can  also  be 
generated  but  is  not  considered  here. 


Figure  2  describes  the  perturbation  model  of 
sensor  displacement  relative  to  a  collinear  array. 
In  this  figure,  each  yt(k)  denotes  perpendicular 
displacement  from  the  mean  array  axis  for  each 
respective  sensor.  The  ai(k)  vectors  are 
related  to  the  lateral  displacements  by  the 
transformation 


i,(k)  = 


"cos  C0  sin  C0  I  r<kTS0  -  iL)  " 
[-sin  C0  cosC0  [  yi<k> 


(2.4) 


y2(k) =  y-i(k)  ♦  d(k)  *  L  tan  «  (2.7) 

y3(k)=  y1(k)  +  2Ltan«  .  (2.8) 


The  respective  displacements  yi(k)  are  related  to 
each  other  due  to  the  physical  dynamics  of  moving 
a  non-rigid  body  through  the  medium.7  For 
purposes  of  analysis,  array  displacements  are 
assumed  here  to  oscillate  at  frequency  ,u0 ,  and  are 
;iven  by 


y,(k)  =  h,  sin  (io0  kT  -  i  PL) ,  (2.9) 

where  p  represents  a  positional  phase  component. 
When  P'~0/S0  and  ht»h  for  all  i,  the  array 
traces  out  a  single  curve  in  the  absolute 
coordinate  system  as  it  is  pulled  through  the 
medium.  For  this  case,  the  displacement  at  one 
point  along  the  array  is  merely  a  delayed  version 
of  array  displacement  at  another  point  along  the 
array.  In  general,  array  motion  is  a  dynamic 
response  to  excitations  delivered  from  the  observer 
and/or  distributed  along  the  array.  These  excita¬ 
tions  can  be  broadband  or  narrowband  processr* 

By  varying  <«0  ,  estimator  performance  can  be 
analyzed  as  a  function  of  frequency.  Hence,  the 
spectral  nature  of  the  excitation  need  not  be 
identified.  Note  chat  with  this  harmonic 
description  of  array  motion,  d(k)  and  tan(0(k)) 
are  also  harmonic  in  the  same  frequency  cue  to  the 
linearity  of  equations  (2.5)  and  (2.6)  in  these 
variables. 

III.  PERTURBATION  ANALYSIS 


At  each  sample  time,  an  instantaneous 
localization  solution  is  provided  by  directly 
mapping  time  delays  into  wavefront  curvature  range 
and  bearing.  For  the  case  of  an  unperturbed 
array,  it  is  easily  shown  that  the  mapping  takes 
the  form* 


where  Co  and  So  denote  observer  heading  and 
speed,  respectively. 

Parameters  describing  general  array  deforma¬ 
tion  in  lieu  of  arbitrary  lateral  displacements 
are  also  described  in  figure  2.  These  are  array 
distortion  and  rotation,  viz.. 


1.2.02(7, 2-  r22)/2 

R  =  - 

c(t2-  7, ) 


4RL  I 


(3.1) 


(3.2) 


d(k)  -  y2(k)  -  (y-i(k)  *  y3(k))/2 
9(k)  =  tan’1[(y3(k)  -  y,(k))/2L]  , 


(2.5)  where  R  denotes  contact  range  relative  to  the 
mid-array  and  0  denotes  the  relative  bearing  as 
measured  from  broadside  to  the  array,  with  time 

(2.6)  index  k  omitted.  When  array  elements  are 
perturbed  off  the  mean  array  axis  as  shown  in 
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figure  2,  equations  (3.1)  and  (3.2)  no  longer 
apply.  Hence,  utilizing  percurbed  time  delays  in 
the  above  mapping  results  in  a  biased  localization 
solution.’  The  extent  of  this  bias  and  its 
effect  upon  contact  velocity  estimates  is  now 
shown. 


AR  =  _  /  fftfi  * 2»2  \  6 

L  \  <»  i»cos/jt  / 

.f^ltan#- Ao2-Atan2* 

<>  <»  o 


Consider  as  unperturbed  time  delays  those 
noise-tree  measurements  obtained  from  sensors 
aligned  with  the  mean  array  axis.  Then,  as  array 
elements  are  perturbed  by  the  corresponding 
displacements  yi ,  it  can  be  seen  chat  the 
perturbed  ray  path  ranges  become 

RiP=  R,[1  -  yi(yi-2RtCOS(3t)/R,2]1/2  ,  i=1,2,3  (3.3) 


where  R,  and  J,  represents  the  true  (unperturbed) 
range  and  bearing.  Expanding  (3.3)  by  a  second 
order  Taylor  series  and  using  measurement 
equations  (2.2)  and  (2.3),  Che  perturbed  time 
delays  become 


Ip  ‘I 


*Ar,  j  =1,2. 


(3.4) 


where 


c 


»i-r 

L  Rl-i 


('y> •’*  2Rtcos0,)2  -J'jj  ( -y |  *  2R, cos/3,) 


(3.5) 


represents  the  time  delay  perturbation. 
With  y,«Rj,  and  L/R,«l,  then  Rj.i/Rj»l. 
Combining  this  with  equations  (2.5)  and 
(2.6)  yields 


ari  = 

_  (d  ♦  L  tan*)  cos/3, 

(3.6a) 

c 

*1 

(d  -  L  tan«) cosfl, 

(3.6b) 

C 


These  expressions  are  now  used  to  replace  r , 
with  its  perturbed  value  r  ,p  in  equations  (3.1) 
and  (3.2)  to  obtain 


A-B(com*,)d  •  EL  com*,  land  -  (com2*,))!2  -  LJcom2fl,l»n2  d 

R  «  —  ...  (.  j  .  /  a ; 

B  -  2(com0,)  d 


and 

p-  sin-'  j  -A  •  (com*,)  tans 
1  2L 

.  BE-2E(coi*,)d  *  2BLcom0,  l*n«  -  4L2(com2*,)  d  land) 
—  ) 
where  .  .  „ 

A  =  L2-c2(r2*r2)/2 

8  ;  c  (~2  -  7,) 

E  -  c  (r,  ♦  r2)  . 


(3.7b) 


where  8,  -  _  ^ 

p=  — ■  5-  — 

2pb 

n  cos/3, 

. 

Expanding  (3.7b)  using 

the  first  order 

Taylor 

series  expansions  for  sin‘  (•)  and  l/<* 

,  the  bias 

in  bearing  is 

f-  cos2/3,  sin  /j,! 

C  3cos20,-2] 

tan#  (3-9) 

L  2p3  J 

L1  +  2p2  J 

• 

Biases  in  range  race  and  bearing  rate  can  now  be 
found  by  differentiating  (3.8)  and  (3.9),  viz.. 


AR 


—  =  cip  ♦  c2/]t  ^36*  c4e 


(3.10) 


where 


e,  =  1  f-  4a  a- 2  tans,  tan*  -(1  -  4a£  )  a2  -  tan2*  I 

a J Leo*d,  co*2*,  J 

Cj  =  1  i.la  tan*  *  4plan0,  s2  -Ae?  A  land  1 

a2  L  co*2*,  com2/),  com*,  J 

e«  *l[-(com0,  *  2a?  )  -  2P  A  ♦  t*nd  -  2a?  a2  .  2a?  tan2*} 

J  „21_  com*,  com2*,  com*,  com  0,  J 

C.  ,  [ -2otan  0,-4  ehOUkd.  2p  land  -  4s?  a  land] 

o2  L  com2*,  co*dt  J 


and 

where 


AJ3  =  C5P  *  c6/3,  "  C76  -  Cg  * 


(3.11) 


( 3co»2^,  sin/3t^  .^3cos^2j(an  „ 


3  V  2p“ 

/2cosflt  -  3  cos3#, 

^  A  2*3 

c  =  .  cos2g,  sing, 

2p3 


tan  # 


c8  =  sec2# 


1  -  3cQ32fl,-2 

2p2 


Some  important  observations  regarding 
equations  (3.8)  through  (3.11)  can  now  be  made. 
First,  note  that  when  P»  1  ,  bearing  error  is 
dominated  by  unmodelled  rotation*  ,  while  rotation 
rate  d  dominates  the  bearing  rate  error.  This  is 
expected,  considering  the  coordinate  rotation 
necessary  to  realign  the  mean  array  axis  with  the 
actual  array.  At  near  broadside,  range  error  is 
essentially  determined  by  distortion.  With 
I5i«p<1  ,  then  as:  I  and  for  small  rotation  and 
near  broadside  bearing 


Csirtg  the  far  field  approximations’ 
B»L'cos  ‘ j  , /R ,  and  E=-2Lsini3,  ,  the  bias 
in  range  is  given  by 


■3R  =  .  2 p2i 

L 

A/3  -  tan  Q 

V  (3.12) 

AR  "  -  2 p2* 

L 

Aj$  =  0 

/  . 

Indeed,  the  product  p&  characterizes  the  i 1 1  — 
conditioning  effects  induced  by  array  motion 
mismodelling  on  localization  estimates.  When 
array  shape  is  concave  (5<0),  contact  range  is 
biased  long,  approaching  infinity  forJ*-1/2p, 
while  for  a  convex  array  shape,  range  is  biased 
short.  Relative  speed  S  can  be  obtained  from  the 
relation 

S2  =  RMR^)\  (3.13) 

With  the  assumptions  described  above  and  the 
special  case  of  zero  relative  speed  considered  in 
the  paper,  the  speed  error  is  given  by 


—  =  [4p4<52+(p(  1  -  2p5)0)2] 
L  L  J 


(3.14) 


Note  that  in  the  decoupled  cases  of0»O  (no 
rotation)  and  d*0  (no  distort  ion ), A S  decouples 
accordingly  into  distortion  rate  and  rotation 
rate,  respectively.  This  case  clearly  illustrates 
the  potential  sensitivity  of  speed  estimates  to 
array  perturbations  rates. 

IV.  ITERATED  LEAST  SQUARES 


Unconstrained  Estimation 

While  localization  solutions  may  be  obtained 
by  direct  mapping  of  time  delays  into  range  and 
bearing,  estimates  of  contact  velocity  are  obtained 
by  processing  time-delay  measurements  over  several 
measurement  samples.  In  either  case,  smoothing  is 
desirable  to  reduce  the  effect  of  measurement 
noise.  Because  Che  measurement  equations  (2.1)  and 
(2.2)  are  nonlinear,  an  iterated  least  squares 
approach  similar  to  that  described  in  (2|  and  (3! 
is  selected  to  estimate  contact  position  and 
velocity  from  Che  measured  data.  Specifically,  an 
iterative  algorithm  based  on  conventional  Gauss- 
Newton  procedures  is  used  to  minimize  Che 
performance  index  (PI)  given  below. 

Defining  the  contact  state  estimate  as 

8  =  CrX(*<0)-ry(><0)VVylT  (  4-l) 

with  r,(k„)  and  ry(k.)  representing 
contact  position  at  some  time  k.  and  (v,, 
vy)  the  (constant)  contact  velocity  estimate, 
the  performance  index  associated  with  the 
unconstrained  estimator  takes  the  form 

Pl(i)  =  f(i>;2,fT(8)f(»)--  I»n3(x)  N>4  „ 


where 

»„(*)  =  0-,(k)  -  ri(k))/oT1  ^r,(k)/on 

*(ll  r(k)-i,.1(k)n  ■  ii r(k)  -  a,(k)  ii)/co7  (4.3) 

for  j=l  or  2  depending  upon  whether  n  is  odd  (j=I) 
or  even  (j=2),  and  where  currenc  range  is  related 
to  r(k„)  by 

fxOO  '  f  x(^o)  r  (k-XoJTv,  (4.4a) 

'yW  ~  'y(k0)  ”  (k*k0)TVy  .  (4.4b) 

The  iterative  procedure  for  obtaining  the 
contact  state  estimate  is 

X|.1  =  X,  *zgj  (4.5) 

where  i  is  the  iteration  index,  z  is  the  step- 
size,  and  gi  denotes  the  search  direction 
vector.  Here,  gi  will  be  found  by  minimizing  a 
linearized  version  of  the  performance  index  which 
is  based  on  a  Gauss-Newton  first  order 
linearization  procedure."  1  Specifically,  this 
performance  index  takes  the  form 

Plutx,)  =l|TJ(a,)g4  *Tf(»|>|2  ={”-]  g,  -  [i]„  (4t6) 

where  J(x, )  denotes  the  Jacobian  of  F(xl)  and 
is  described  in  the  appendix.  To  avoid  matrix 
inversion,  the  orthogonal  transformation  T  known 
as  the  Householder10  has  been  utilized.  This 
operation  transforms  Che  Jacobian  into  partitioned 
components  consisting  of  an  upper  (4x4)  matrix  U 
and  a  ((N-4)x4)  null  matrix.  The  measurement 
residual  vector  f  is  transformed  into  the  (4x1) 
vector  T  and  the  ((N-4)xl)  vector  e".  The  search 
direction  vector,  g, ,  is  the  solution  to  the 
normal  equations  associated  with  Pit,  namely 

gi  =  u_ir  ,  (4.7) 

A  back  substitution  algorithm10  is  employed  to 
preclude  inversion  of  U.  With  g,  determined, 
the  step  size  z  is  determined  as  in  [3|.  The 
iteration  procedure  is  initialized  by  utilizing 
the  wavefront  curvature  range  and  bearing  defined 
in  the  previous  section.  Specifically,  time  delays 
are  mapped  into  positional  components  while  contact 
velocity  is  initialized  at  zero.  Iteration  is 
continued  until  either  a  terminat ion  condition  is 
detected  (i.e.,  the  percent  change  in  PIL  falls 
below  some  threshold)  or  a  maximum  allowable  number 
of  iterations  is  reached  (typically  sec  at  50). 

Estimation  with  Inequality  Constraints 

General  inequality  constraints  will  now  be 
incorporated  into  Che  least  squares  estimator. 
Constrained  contact  state  estimation  requires 
minimization  of  the  performance  index  of  equacion 
(4.2)  subject  to  general  inequality  constraints  of 
the  form 

R  MIN  ~  Cl(*)  9  WAX  (4.5) 

where  q(x)  denotes  the  vector  ot  functionals  that 
are  to  be  bounded. 


One  .approach  in  solving  inequality  constraint 
problems  is  to  define  slack  variables  of  the  form 


V.  EXPERIMENTAL  RESULTS 


"?  =  ,„IN  )  =  bj(S)  .(^-9) 


The  slack  variable  method  converts  minimization 
with  inequality  constraints  to  minimization  with 
equality  constraints  since  in  order  for  <»j  to  be 
real,  relation  (4.8)  has  to  be  satisfied. 
Lagrange  multipliers  are  used  to  adjoin  these 
variables  to  the  original  PI  via 

M 

P«c  =  P'u+£Ma|2-bl<*>> 

i=l 


with  Pie  and  PIu  denoting  the  unconstrained  and 
constrained  performance  indices,  respectively. 
Mote  that  for  minimization  of  PIC, 


Furthermore,  the  ai  need  not  be  directly  computed, 
but  rather  can  be  eliminated  to  yield  the  Kuhn- 
Tucker  conditions.4 


Aibi(»)  =  o 

(4.12a) 

X,  CO 

(4.12b) 

^  *1,  max 

l«1_  M  . 

(4.12c) 

With  no  loss  of  generality,  the  unconstrained 
measurement  residual  vector  is  augmented  as 

»(8)  =  [»1 . «N.CV  .. 

•,C„]T 

(4.13) 

where 

Ci=  b,(S) 

(4.14) 

The  unconstrained  Jacobian  is  augmented  by  an  addi¬ 
tional  row  for  each  constraint  that  is  violated 
(see  appendix). 

Hence,  the  contact  state  estimate  is  obtained  by 
applying  the  Gauss-Mewton  iterative  procedure 
described  in  the  previous  section  to  the  following 
modified  performance  index 

M 

P'e  =  P'„-£  A' *>!<*>  .  (4.15) 

i*1 

When  constraints  are  violated,  iteration  continues 
until  c  nstrained  parameters  reach  the  predeter¬ 
mined  boundary.  Selection  of  Lagrangian  multi¬ 
pliers  can  be  achieved  through  an  iteration  process 
as  in  (8).  Assuming  there  are  no  contradictory 
constraints  and  that  the  degree  of  modelling  error 
is  not  so  severe  as  to  preclude  realization  of  the 
constraint,  then  each  X j  increases  in  magnitude 
through  iteration  until  the  constraint  is  realized 
( i .e. ,  X j  *X,o ) •  Mote  that  Lagrangian  multipliers 
with  values  greater  than  X  io  have  no  additional 
effect  upon  the  PI  since  bi(x)  vanishes. 


To  illustrate  the  sensitivity  of  contact  speed 
estimates  to  array  motion  mismodelling,  several 
simulation  experiments  were  conducted  using  the 
geometry  described  in  figure  3.  This  scenario 
represents  a  parallel  geometry  where  relative 
motion  between  contact  and  observer  is  zero  and 
cotanences  with  the  contact  being  broadside  to  the 
observer  (0«135*).  Nominal  values  of  observer 
and  contact  speed  are  both  set  to  0.01  L/sec  where 
L  is  sensor  separation.  A  normalized  initial  range 
(R/L)  of  80.0  was  employed.  For  the  first  set  of 
experiments,  time-delay  measurements  are  assumed 
to  be  noise  free  (i.e.,  SNR«*>).  Data  was  collected 
over  a  processing  interval  of  10  minutes  containing 
a  total  of  100  equispaced  measurements.  The  sinu¬ 
soidal  perturbation  model  given  by  equation  (2.9) 
was  used  to  individually  describe  array  distortion 
and  rotation. 

Sensitivity  of  contact  speed  estimates  to  array 
perturbations  is  depicted  in  figures  4  and  5. 
Specifically,  figure  4  depicts  the  sensitivity  to 
array  distortion  (zero  array  rotation)  while 
figure  5  depicts  sensitivity  to  array  rotation 
(zero  array  distortion).  Note  that  for  negative 
distortion  values,  the  speed  error  peaks  are 
shifted  left  at  lower  frequencies.  Speed  error 
curves  for  negative  rotation  angles  have  been 
omitted  since  they  were  observed  to  coincide  with 
those  in  figure  5.  The  sensitivity  curves  are 
plotted  as  a  function  of  normalized  frequency 
fa,  where  ui.*27T  f „/600  is  used  in  the  respective 
perturbation  models.  Note  that  speed  estimates 
can  significantly  be  affected  by  a  relatively 
small  perturbation  in  rotation.  Using  the 
sinusoidal  perturbation  model  dictates  that 
distortion  and  rotation  rates  increase  with 
frequency.  However,  the  speed  errors  plotted  in 
the  figures  are  actually  "smoothed"  errors. 

Hence,  speed  estimates  are  shown  to  be  particularly 
sensitive  to  array  perturbations  in  a  certain 
intermediate  frequency  interval.  As  indicated  in 
the  perturbation  analysis,  for  (d/L)«(R/L)>l ,  very 
large  speed  errors  are  generated;  this  was  also 
observed  experimentation. 

The  potential  performance  gains  -ealized  by 
incorporating  a  speed  constraint  are  illustrated 
in  figures  6  and  7.  Performance  improvement  is 
depicted  by  the  ratio  of  constrained  to  uncon¬ 
strained  contact  state  estimate  errors.  Figures  6a 
and  7a  depict  estimation  with  an  equality  speed 
constraint,  (S,u  =  Sm,,  =  Strut),  while  6b 
and  7b  result  from  incorporating  inequality 
constraints  (Smin  —  0,  Snt ,  —  3Stru«).  Mote 
that  in  all  these  figures,  estimation  accuracy  is 
significantly  improved  for  only  one  contact 
parameter  at  any  particular  frequency.  When 
equality  constraints  are  imposed,  improvement  is 
realized  over  nearly  the  whole  frequency  spectrum. 
However,  due  to  smoothing  effects  of  the  estimator, 
performance  improvement  realized  from  the 
inequality  constraint  is  obtained  only  over  the 
frequency  interval  where  speed  estimates  are  most 
sensitive  to  array  motion  modelling  errors,  and 
hence,  the  constraint  is  violated. 
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Figures  8  and  9  describe  the  effects  of 
modelling  error  and  improvement  via  the  speed 
constraint  for  a  Monte  Carlo  simulation,  where  the 
same  geometry  of  figure  3  is  used,  and  only 
distortion  is  considered.  For  this  case,  time 
delays  are  corrupted  by  zero  mean  white  gaussian 
noise  of  variance?,,2  =  2.5x10'*,  and  a  random 
phase  component  distributed  between  (0,2r)  is 
incorporated  into  the  sinusoidal  perturbation 
model.  The  Monte  Carlo  experiment  consisted  of  30 
sample  runs,  from  which  error  statistics  were 
computed.  Figure  8  describes  the  sensitivity  of 
estimated  speed  to  distortion  for  d/L  »  0.001,  and 
is  consistent  with  figures  4  and  5.  Figure  9a 
describes  the  improvement  in  mean  range  error  for 
the  cases  where  the  same  equality  and  inequality 
constraints  described  above  are  utilized. 

Figure  9b  describes  the  improvement  in  range  error 
variance  for  the  two  constraint  conditions.  Again 
these  results  are  consistent  with  the  single  own 
experiment  described  above. 

VI.  SUWARY  AND  CONCLUSIONS 


The  focus  of  this  paper  has  been  to  (1)  demons¬ 
trate  the  sensitivity  of  contact  velocity  estimates 
to  array  shape  modelling  error,  and  (2)  to  show 
performance  improvement  of  contact  state  estimation 
with  a  speed  constraint  when  such  modelling  errors 
are  present.  Specifically,  sensitivity  of  esti¬ 
mated  contact  speed  to  unassumed  array  deformation 
has  been  demonstrated  through  a  perturbation 
analysis  of  wavefront  curvature  range  and  bearing, 
yielding  contact  velocity  as  a  function  of  actual 
relative  velocity,  shape  error,  and  rate  of  change 
of  the  shape  error.  A  sinusoidal  error  model  was 
used  to  characterize  speed  error  as  a  function  of 
frequency  to  show  where  estimated  speed  is  most 
sensitive.  This  sensitivity  was  demonstrated 
through  simulation  via  an  iterated  least  squares 
algorithm.  Note  that  while  the  perturbation 
analysis  describes  predicted  speed  error,  simu¬ 
lation  results  contain  the  low  pass  filtering 
effect  of  smoothing  provided  by  the  least  squares 
estimator.  The  analysis  was  based  on  assuming  a 
collinear  array.  However,  it  is  expected  that  the 
same  form  of  contact  velocity  sensitivity  to  array 
motion  mismodelling  will  result  for  more  general 
array  shape  assumptions. 

Experimental  results  also  illustrated  the 
potential  performance  gains  that  can  be  achieved 
through  utilizing  a  priori  contact  speed  informa¬ 
tion.  Specifically,  estimation  accuracy  was 
enhanced,  and  the  use  of  equality  constraints  was 
shown  to  provide  performance  improvement  over  the 
whole  frequency  spectrum.  However,  when  more 
general  inequality  constraints  are  utilized, 
improvements  in  contact  estimates  occur  only  in 
the  frequency  intervals  where  they  were  most 
sensitive  to  array  motion  modelling  errors. 

APPENDIX 


The  Jacobian  matrix  required  for  solution  of 
the  Gauss-Newton  equation  is  defined  by 


(A.  1 ) 


where  f  is  the  unconstrained  measurement  residual 
vector  of  equation  (4.2)  and  x  is  as  defined  in 
equation  4.1.  Each  row  of  the  Jacobian  then  takes 
the  form 


dl„  ;?,(k) 

o%  '  (A-2) 


where  j*l  for  odd  numbered  rows  and  j»2  for  even 


numbered  rows,  and  r|  is  defined  by  equations 
(2.2)  and  (2.3).  Let  D-T(k-k„)  and 

J,-’( 

P  00  -  p  00' 

i  (M)*  ix  j 

)/C 

(A. 3a) 

II 

wk,-vk>; 

)/c 

(A. 3b) 

where 

pj(k)  = 

M»0-*i00 

l?(k)-ij(k)| 

j=1,2,3  . 

(A. 4) 

Then  each  pair  of  rows  of  the  Jacobian  matrix  is 
given  by: 


J1x  J1y  DJ1x  DJ1y 

J2x  J2y  D^2x  DJjy 


The  respective  p i (k)  vectors  represent  unit 
vectors  emanating  from  each  sensor  and  directed 
toward  the  contact  at  sample  time  k. 


Violation  of  imposed  inequality  constraints 
requires  augmentation  of  the  residual  vector  and 
the  Jacobian.  When  the  speed  constraint  is 
violated,  the  unconstrained  residual  vector  is 
augmented  by 


*N+1  («)MSmax-S(x))(S(x)-Smin) 

(A. 6) 

where  S(x)  =  [ v x2  *  vy2]1/2 


The  elements  of  the  additional  row  of  the  Jacobian 
matrix  is  given  by 


[o  o  kv,/S  kVy/S] 


(A.  7) 


where 


(A. 3) 


is  proportional  to  the  deviation  from  the  midpoint 
between  the  constraint  boundaries. 


ACKNOWLEDGEMENT 


The  authors  wish  to  acknowledge  the 
Mrs.  Cheryl  Cote  and  Mrs.  Jear.ne  Chaves 
paring  the  original  manuscript,  and  the 
support  provided  by  Mr.  Marcus  Graham, 
was  supported  by  NUSC  IR  funds  (Project 
tasks  62633N  and  735P80. 


efforts  of 
for  pre¬ 
programming 
This  work 
A7911)  and 


6 


REFERENCES 

[1]  G.C.  Carter,  "Time-Delay  Estimation  for 
Passive  Sonar  Signal  Processing,"  IEEE 
Trans.  Acoustics,  Speech  and  Signal 
Processing,  Vol.  ASSP-30,  No.  3,  June  1981. 

[2]  D.J.  Murphy,  "Target  Tracking  with  a  Linear 
Array  in  an  Underwater  Environment," 
Proceedings  of  14th  Asilomar  Conference  on 
Circuits,  Systems,  and  Computers,  November 

1982. 

• 

[3]  D.J.  Murphy,  B.W.  Guimond  and  D.W.  Moore, 
"Linear  Array  Tracking  of  a  Maneuvering 
Target,"  15th  Asilomar  Conference  on 

•  Circuits,  Systems,  and  Computers,  November 

1981. 

[4]  K.F.  Gong,  A. A.  Magliaro  and  S.C.  Nardone, 
"Parameter  Estimation  in  a  Constrained  State 
Space,"  17th  Asilomar  Conference  on 
Circuits,  Systems,  and  Computers,  November 

1983. 

[5]  K.F.  Gong,  A.G.  Lindgren,  and  S.C.  Nardone, 
"Passive  Target  Localization  and  Motion 
Analysis  with  a  State  Parameter  Constraint," 
15th  Asilomar  Conference  on  Circuits, 
Systems,  and  Computers,  November  1981. 

[6]  S.C.  Nardone  and  V.J.  Aidala,  "Observability 
Criteria  for  Bearings-Only  Target  Motion 
Analysis,"  IEEE  Trans,  on  Aerosp.  Electron. 
Syst.,  Vol.  AES-17,  March  1981. 

[7]  A.P.  Paidoussis,  "Dynamics  of  Flexible 
Slender  Cylinders  in  Axial  Flow,"  Journal  of 
Fluid  Mechanics,  Vol.  26,  1966. 

[8]  J.C.  Hassab,  B.W.  Guimond,  S.C.  Nardone, 
"Estimation  of  Location  and  Motion 
Parameters  of  a  Moving  Source  Observed  from 
a  Linear  Array,"  J.  Acoust.  Soc.  Am.,  Vol 
70,  No.  4,  October  1981. 

[ 9 1  J.C.  Hassab,  "The  Effect  of  Uncertainty  in 
the  Heading  or  Placement  of  a  Subarray  on 
Passive  Ranging  Accuracy,"  J.  Acoust.  Soc. 
Am.,  Vol  75,  No.  2,  February  1984. 

u 

[10]  G.J.  Bierman,  Factorization  Methods  for 
Discrete  Sequential  Estimation,  Academic 
Press,  1977. 


F l gure  1  Tracking  «uh  a  Linear  Array 


Figure  2.  Array  Shape  Oeecrlption 


Flgure3.  Scenario  Description 


Figure  4  Senei tivi  ty  of  Speed  Estimate  to  Distortion 


Figure  5  Sensitivity  oi  Speed  Estimate  to  Rotation 
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Figure  6a .  Iaproveaent  via  Speed  Constraint  in  Figured  Sensitivity  of  Mean  Speed  Estlaate  toDistortion 

Presenoe  of  Distortion.  S  *u/5in»e  s  1  (Monte  Carlo) 


Figure  6b.  Iaproveaent  via  Speed  Constraint  in  Figure  9a  Iaproveaent  in  Mean  Range  Error  viaSpeedConstraint  in 

Presence  of  Distortion,  S  S  Presence  of  Distort  ion  ( Monte  Carlo 


NORMALIZED  FREQUENCY  (ffl) 

Figure  9b  loproveaent  in  Range  Error  Variance  via  Speed 


Constraint  in  the  Presence  of  Distortion 
( Monte  Carlo  ) 
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